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ABSTRACT 



The Marine Corps and Army are developing a 
Position Locating Reporting System to aid the 
battlefield commander in locating his assets during 
battle. 

This study hras applied Extended Kalman Filtering 
technigues to that problem, evolving from a simple 
Extended Kalman Filter Observer to three moving 
observers, whose position is uncertain, estimating the 
position cf another unit. 
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I. 



INTROD UCT ION 



The precise location of all assets in and about the 
battle area is of prime importance to the tactical Marine 
Commander. In the past locating has had to depend on the 
individual knowing his own position and being able to report 
it through radio links to higher command. This system 
suffered from the limitations of terrain, daylight, weather, 
and the volume of radio traffic during battle. 

To alleviate these shortcomings the Marine Corps and 
Army are investigating a Position Locating and Reporting 
System (PLRS) to collect, process, and, display the location 
of units, vehicles, and aircraft in and about the battle 
area. 



The PLRS consists of field units and a master unit. The 
field unit is compact enough to be carried in the field by a 
man, vehicle, or aircraft. These units will determine the 
range to other field units in the area and report this 
information to the master unit for processing and display. 
The range information is determined by measuring the time 
required to send a signal from one unit to another and back 
again plus some "system" delay. When a unit's position is 
being updated it is referred to as the " Update" unit; and 
all others are referred to as "Ranging" units. 

In a previous study in this area,[1], tests were 
conducted to investigate the use of the error ellipse in 
visually displaying the degree of uncertainty of the 
position of an update unit and the effect of numerous 
updates on reducing that degree of uncertainty it was 
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found that the degree of uncertainty is reduced in the 
direction of the ranging unit with consecutive updates as 
shown in Fig 1 taJcen from that study. 

That study also simulated one jet aircraft flying Mach 1 
in a constant radius turn as an update unit being ranged on 
by two stationary ranjging units to explore the proper random 
forcing excitation covariance necessary for adequate filter 
performance. 

i 

It is the intent of this study to further expand the 
simulation begun iui the previous work by adding an 
additional ranging unit, allowing the movement of the 
ranging units, and considering the effect of ranging from a 
unit whose position is not known exactly 
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Figure 1 - CONSECUTIVE UPDATES »ILL REDDCE THE DEGREE OF 
UNCERTAINTY IN THE DIRECTION OF THE RANGING UNIT 
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II. 



EXTENDED KALMAN FILTE RING 



The Extended Kalman Filter is widely documented and no 
attempt at a development of that theory will be made in this 
work. A brief treatment has been included to establish 
nomenclature and formulas used. For a more complete 
development one is referred to reference [2] or similar 
texts. 

As defined in this work, PLRS is described by a set of 
discrete, linear, cartesian system equations 



and a set of discrete non-linear measurement equations 



where £ and r_ are linear functions and m is a nonlinear 
function of the state variables x (k) ; w_(k) is the excitation 
noise and v(k) is the measurement noise of the system. 

The plant noises are considered uncorrelated, zero-mean, 
and white. 

The non-linear measurement equations can be linearized 
by expanding equation (2) around the best estimate at time k 
and using the first-order terms yielding 



x_(k+1) = £.(k) _x_(k) + r_(k) _w_(k) 



0 ) 



_z_(k) = ra(x(k),k) + v (k) 



( 2 ) 
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z (k) = a (k) x (k) +■ v (k) 



where 



3 tn 

H(k) = — 

3 x x=x(k/k-1) 



( 3 ) 



xjk/k) is the estimated value of the state at k after 
th 

the k measurement and x (k/k-1) is the predicted value of 

th 

the state at time k before the k measurement. 

The state error vector is 

£' (k/k) = x (k/k) - x (k) 

and the predicted error vector is 

x' (=k/k-1) = x (k/k-1 ) - x (k) 



The covariance of the state error matrix is 



„ T 

P (k/k) = E(x' (k/k) x' (k/k)] 



and the predicted covariance of the state error matrix is 



~ T 

P (k/k-1) = E( x ' (k/k-1) x' (k/k-1) ] 
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The state excitation matrix is 



Q(k) = s:i(k) w(k) /(k)l^ T (k)] 
and the measurement noise covariance matrix is 

S(k) = E[v(k) / (k) ] . 

The equations that made up the Kalman Filter used in 
this work are as follows: 

T 

P(k/k-d) = A(k) P (k/k) A (k) + Q(k) 

T T -1 

G ( k) = P (k/k-1 ) H (k) [ H (k) P (k/k-1) H (k) * R (k) ] 

P (k/k) = [I - G(k) H (k) ]P (k/k-1) 

x (k/k) = x (k/k-1) + G (k) [_z (k) - H(k) x (k/k-1) ] 

£ (k/k-1 ) = A(k) x(k/k) 

zjk) = m_ (2L( k/k-1) ,k) 

Since the only observations in this system are ranges. 
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the observation equation is 



1/2 

z (k) = [x* (k) + y 2 (k) ] 



and from equation (3) we get 



H (k) 



x(k) 

x2(k) + y2(k) 



y(k) 

x2(k) + y 2 (k) 



0 . 



The covariance of estimation error,?, is and expression 
of the uncertainity. in the estimation of the states. 
Considering only the estimation's position error, P 

position 

can be expressed as 



a 



2 

X 



P 

.position 



CyO X 



O O 

x y 



2 




Since the position estimation error is normally 
distributed, a curve of constant error probability can be 
defined by using the exponent of the normal distribution. 



X2 



0 



2 

X 



2r xy 
xy 



0 o 

x y 



Y 2 



+ 
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This curve defines an ellipse- Graphically, for the given 
probability, the estimation may be anywhere in that ellipse. 
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III. CHOOSING THE BEST R ANGE R 



To move from a simple Kalman Filter observer to the PLRS 
model, the first problem encountered was to choose the best 
ranger from which to take the measurement. In the previous 
work ,[ 1 ], it was shown that the most useful measurement, 
the one causing the most reduction in the error ellipse, is 
obtained by observing the update unit from a point aligned 
with the major axis of the error ellipse of the update unit. 

To find the ranger most closely aligned with the major 
axis of the update unit's error ellipse the orientation of 
the error ellipse must first be found using the following 
equation. 



0 



! tan- 1 
2 



2 Cov (x,y) 




This angle (0) gives the angle between -90° and 90° that the 
x-axis of the ellipse makes with the x-axis of the 
co-ordinate system. Looking at the ellipse in this new 
posture one can find the new » Uncorrela ted" variances that 
define the major and minor axes. 



a z * o*. Col(l,y) 

a * — * 

x 2 Sin 20 

2 » = q 2 * q 2 Cov [lill 

°y 2 Sin 20 
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If a 2 is greater than 0 Z the x-axis of the error ellipse 
x y 

is the major axis and 9 is the angle we seek. If a 2 is 

y 

greater than o 2 then the y-axis of the error ellipse is the 

x 

major axis and the angle we seek is 9+90°. 

The bearing of th;e update unit from the ranger must then 
be found and it is simply 

3 i Tan-i LuULr . 

u R 



The absolute value of the difference between 9, after 
proper correction, and 3 was chosen as the best alignment 
indicator; but to be aligned and to be 180° out of alignment 
is of equal value;' therefore the absolute value of the 
cosine cf the differences was used as the alignment 
indicator and the ranger found to have the largest indicator 
was chosen as the ranging unit for that measurement. 
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XV. P LRS SIMULATION 



A. TWO HANGING UNITS 



In previous work-,[ 1 ], the PLHS simulation was setup for 
a jet aircraft flying Mach 1 in a constant 10 Km turn about 
the origin to act as the update unit for all measurements. 
Two stationary ranging units were placed at the origin and 
at lOKm north, 10Km east. Using a one second sample 
interval, the jet was described by the following matrices: 

110 0 

0 10 0 

4> = 

0 0 11 

0 0 0 1 

0.5 0 

1 0 

r 

0 0.5 

0 1 

Its initial state was 

0 

0.333 Km /s 

x = 

10 Km 
0 
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Its initial covariance of error matrix, measurement noise 
covariance, and excitation forcing matrix were 



-4 

10 0 



O' 0 



-4 

10 0 
-4 

0 10 



and 

-4 

H = 10 

with 



P(1/0) = 



10 

0 

10 

0 



-4 



-4 



10 

0 

0 



-4 



-5 -5 



2. 5x10 
-5 


5x10 

-4 


0 


0 


5x10 


10 


0 


0 


- 




-5 


-5 


0 


0 


2.5x10 

-5 


5x10 

-4 


0 


0 


5x10 


10 



Fig 2 is a display of its final runs. The filter 
tracked accurately and the error ellipses shown are twenty 
times their actual size to make them visible. Table 1 shows 
which was the ranging unit at each measurement time. 
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Figure 2 - PLRS SlflOLATION - A JET IN A CONSTANT 10KM 
RADIOS TORN FLTING BETWEEN TWO STATIONARY RANGERS 
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B. THREE RANGING UNITS 



The first step of this study was to add a third ranging 
unit at 0 north, 10Km east. The algorithm was enlarged to 
include the additional unit and its comparison with the 
alignment indicators of the other ranging units. 

It can be seen in; Fig 3 that the size of the error 
ellipses were reduced in size in the mid-range area where 
the jet and the two original units were in line; and the 
third ranger provides the triangular measurement. 

Table 2 shows the ranging unit chosen for the 
measurement at each time k„ 
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Figure 3 - PLRS SIMULATION - A JET IN A CONSTANT 10KM 
RADIOS TORN FLYING AMONG THREE STATIONARY RANGERS 
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C. HANGING UNITS IN flOTION 



In the second step the rangers are given motion. The 
rangers at the origin and at lOKm north, lOKm east were to 
move north and south respectively at 3Kts as infantrymen. 
The ranger at 0 north, lOKm east was to move west at 120Kts 
as a helicopter. Again using one second sample intervals, 
their motion was defined using discrete linear state 
eguations 

x(k+1) = <j>(k) x (k) , 

where 

110 0 

0 10 0 

9 = 

0 0 11 

0 0 0 1 

with the initial states shown below; 

0 

0 

X = INFANTRYMAN 

0 

1.67x103 Km/s 

10 

0 

X = INFANTRYMAN 

10 

-1.67x10 3 Km/s 
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X 



12 

-5.555x10 2 Km/s 



HELICOPTER 



0 

0 



It can be seen in Fig 4 that no system depreciation 
resulted from the motion of the rangers. Table 3 shows the 
ranging unit chosen for the measurement at each time. 
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Figure 4 - PLRS SIMULATION - A JET IN A CONSTANT 10KM 
RADIOS TURN FLYING AMONG THREE MOVING RANGERS 
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D. 



SOURCE OF MEASUREMENT NOISE 



s In the above simulations the position of the ranging 
unit has been assumed to be exact; while in actual 
application the ranging units will have covariances of 
estimation error defining an error ellipse; and the ranging 
unit might be anywhere within that ellipse. To bring this 
position uncertainty into the simulation, the radius of the 
error ellipse along the bearing from the ranging unit to the 
update unit was defined as the covariance of measurement 
error. 

The equation for the radius of an ellipse is a function 

of the major axis, the minor axis, and the angle at which 

the measurement is made. To find the measurement noise 

covariance, or the ellipse radius, 21 and 21 must be 

x y 

compared and the larger defined as Hj, the major axis, and 

the smaller defined as Mn, the minor axis. The angle, a , at 
which the radius is determined is measured from the major 
axis and thus is calculated as the difference between 0 and 
0. Fig 5 shows the geometry of the calculation of the 
covariance of measurement noise. The equation for R and the 
radius squared of the ellipse is: 



Mj Mn 

R = r 2 = 

Mj Sin 2 ct + Mn Cos 2 a 



It can be seen in Fig 6 that performance was improved 
slightly using the covariance of estimation error as the 
sole source of measurement noise. 
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Table 4 shows the ranger chosen at each time for the 
three moving rangers with position uncertainity simulation. 
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Figure 5 - r IS THE RADIUS OF THE ERROR ELLIPSE - r 2 = R 
IS THE COVARIANCE OF MEASUREMENT NOISE 
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Figure 6 - PLRS SIMULATION - A JET IN A CONSTANT 1 OKM 
RADIUS TURN FLYING AMONG THREE MOVING RANGERS WITH POSITION 

UNCERTAINTY 
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V. CON CL OS ION 



The placement of the third ranger showed the value of 
triangulation of the rangers. The closer to normal the 
bearings of the rangers are to each other, the better the 
results of consecutive ranges. 

The allowance for motion and the representation of the 
ranger's position uncertainity as the source of measurement 
error were important steps toward full simulation of the 
system; and they were accomplished without degradation of 
performance. 

A better simulation nay be to represent the measurement 
error as the ranger's position uncertainty plus some system 
measurement error. 

Still to be accomplished is the ability to update all 
units at each ranging, and to provide a gating system that 
will demand more frequent updates for faster moving units 
and less frequent updates for slower units. 

A program listing of the three moving rangers with 
position uncertainity is . included with an annotated data 
deck. 
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